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ABSTRACT 

An innovative approach to autonomous attitude, 
trajectory, and rate estimation is presented for low 
earth orbit (LEO) satellites which relies on 
magnetometers and sun sensors. These two sensors are 
reliable, inexpensive, and are used routinely in LEO 
missions for attitude determination and control. An 
extended Kalman filter (EKF) is developed from two 
existing systems, one which uses an EKF to estimate 
attitude and trajectory using magnetometer and gyro 
data and a second pseudo-linear filter which estimates 
rotation rate using magnetometer and sun sensor data. 
The theoretical background of the combined system is 
presented along with test results from noisy, simulated 
sensor data. 

INTRODUCTION 

Most missions supported by the NASA Goddard 
Space Flight Center (NASA/GSFC) have an attitude 
and orbit determination requirement. In most cases, 
the attitude estimation is performed onboard the 
satellite. However, the orbit determination is 


performed primarily on the ground post pass. Efforts 
are underway to provide for spacecraft onboard 
autonomous orbit determination. However, these 
efforts can be somewhat expensive and have limited 
availability which makes them less attractive to the 
multitude of missions being launched with very modest 
attitude and orbit requirements as well as modest 
budget. 

Previous research demonstrated an approach to 
attitude and trajectory estimation using only magnetic 
field data and rate data 1 . The estimation is performed 
simultaneously using an EKF, a well known algorithm 
used extensively in onboard applications. The 
magnetic field is measured on a satellite by a 
magnetometer, an inexpensive and reliable sensor 
flown on virtually all LEO satellites. The system has 
been developed and successfully tested in a post- 
processing mode using magnetometer and gyro data 
from four satellites supported by the Guidance, 
Navigation, and Control Center at the NASA/GSFC. 
However, the rate data required by this algorithm is 
provided by a gyro, which can be costly. 
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In order for this system to be truly low cost, an 
alternative source for rate data must be utilized. An 
independent system which estimates spacecraft rate has 
been successfully developed and tested using 
magnetometer data and sun sensor data, along with the 
known attitude 2 . This system is much less costly than 
a gyro since it is software based and uses sensors which 
are traditionally flown on low earth orbiting missions. 
Both systems have been combined into one low cost 
attitude, rate, and orbit estimation system and 
preliminary test results have been conducted 3 . 

The resulting system is expected to provide low cost 
navigation, i.e. attitude, orbit, and rates, for low earth 
orbit satellites. The system relies on existing 
hardware, namely, magnetometers and sun sensors. 
Magnetometers are carried on virtually all low earth 
orbit satellites. There has been only 1 reported failure 
of a magnetometer for missions supported by 
NASA/GSFC. Sun sensors are also extremely reliable. 
Both sensors are currently availablean^jnost 
importantly, they are flight qual^^^CSmparable 
systems, such as the Global 
considerably more expensive!, and— flight^qfualified 
receivers which can perform attitude determination are 
not readily available. Any LEO mission, whether 
commercial or government, with coarse accuracy 
requirements or desiring an inexpensive backup 
method for attitude, rate, and orbit estimation can use 
this system, provided the satellite has an onboard 
computer. The impact on the onboard processing 
should not be significantly more than current onboard 
processing and can be accomplished with current 
computing technology. Furthermore, utilizing onboard 
processing reduces the cost of ground operations. 

In this work, the EKF developed to estimate the 
orbit, attitude, and rates and initially tested in 
Reference 3 is presented. The algorithm is 
summarized and the results of further testing are 
included. The testing consisted of noisy, simulated 
data spans up to 48 hours in length; results with an 
attitude maneuver are included as well. 

THEORETICAL BACKGROUND 

The assumed models of the EKF are given as: 
System model: 

X k (t) = f(X k (t),t k ) + u k (l) 


Update Stage 

The linearization of equation (2) results in 

z k = H k x k +n k (3) 

where is the measurement matrix of the combined 
filter at time t k . is composed of sub-matrices which 
reflect the dependence of the effective measurement z^ 
on the state vector, which contains the orbital 
elements, the angular attitude error, and the angular 
velocity. 

Xk T - [a, e, i, Q, w, 0, C d , co] (4) 


where: 

a = semi-major axis 
e = eccentricity 
i = inclination 

Q = right ascension of ascending node 
w = argument of perigee 
0 = true anomaly 
C d = drag coefficient 
£ = attitude error 
cd = rotation rate 


The measurement matrix is 


H k = 


H 0>k H a 0 

0 0 [b k x] 


( 5 ) 


Where and Hajc are, respectively, the submatrices 
reflecting the dependence of the orbital components 4 
and the attitude 5 on the effective measurement. The 
matrix [bitx] is a skew symmetric matrix composed of 
the elements of the measured vector, bk. The 
development of the dependence of the angular velocity 
on the effective measurement follows. 

The effective measurement, contains two 

elements, zi >k and z 2 , k - The first is the difference 
between the measured vector and computed reference 
vector 1 and the second element is the difference in the 
derivatives of the measured vector and computed 
reference vector 2 . Taking the derivatives of the 
computed and measured vectors brings in a 
dependence on the angular velocity through the 
formula: 


Measurement model: 

Zk=hk(X(t k ))+ru (2) 


D l.kik =b k +w k xb k 


( 6 ) 
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where: = angular velocity vector 

& = computed reference vector resolved in 
inertial coordinates 

D’ k = transformation matrix that transforms 

vectors from inertial to vehicle (body) 
coordinates 

bfc = observed vector resolved in body 
coordinates 

Note that ik and bk are the components of the same 
abstract vector. Incorporating the noise into the 
reference and observed vectors, (6) can be written as 


If the sensor is calibrated such that the measurements 
have no bias E{r[ b k} and E{r} tU } are zero and R k 
becomes 


E k,k i?b. k T } E bb,k Hd.k T } 

E k,k \J} E bd,k 


on 


The matrix E{T] btk ri bk T } is the noise covariance matrix 
for the measurement, i.e. R T am for the magnetometer. 
Based on the assumption that the Tj b k and Hbjc-i are 
uncorrelated, Efi^kUdjc 1 } becomes 


b k - ■ °l.kik = [b k x l“k + f^b.k x I® k - \ k + D U \ k 

(7) 

where: u b .k - measurement vector noise at time tk 

U^iT (Hb.k-Hbj c -i)/A 

-r,k= reference vector derivative noise 


E bd.k5d.k T } = D k R TAMDk T +d/A 2 )RTAM < 12 ) 
where the matrix Dk is computed as 

D Ic=[®e S ..k X ] + 0 /A ) 1 (13) 

and I is a 3x3 identity matrix. The noise covariance 
matrix then becomes 


Q>kx] = skew symmetric matrix composed of the 
elements of bk, which is entered into Hk 
above 

A = time between measurements 


R k = 


r tam 

-D k R TAM 


* R TAM D k T 

Dk R TAMDk T +(1/ a2 ) R TAM 

(14) 


In view of (6), the second element of the effective 
measurement is then formally defined by the following 
relationship 

— 2 ,k = (^k — ^v.ktk ) “ [— k x ](!iest,k ( 8 ) 

where: co^.> = current estimated rate 

Assuming the noise from the reference vector to be 
zero, the noise terms in (7) can be combined into 


The update of the state vector and covariance matrix is 
performed using the following equations 

x,j(+) = Xkf-J+KkZk (15) 

Pk(+) = (I-K k H k )Pk(-)(I-K k Hk) T +K k R k Kk T (16) 

where the gain matrix, K* is computed as 

K^PkOHk^PkC-JHk+Rk]- 1 (17) 


\k = [”-lc X ]3b,k-3b,k (9) 

The measurement noise, a b , k , associated with z ljc is 
augmented with the noise t}^ into the noise vector, r^, 
of (3). In order to use this in the filter the covariance 
matrix Rk is computed as 


The state vector, Xk, is the internal state used by the 
EKF. This form is used internally to estimate the 
angular error in the attitude (in addition to the other 
state vector elements) which is then converted to a 
normalized quaternion for propagation. This is the so- 
called ‘multiplicative’ approach 5 . 




^d.k 



The above derivation is valid for a magnetometer. 
For another sensor, such as a sun sensor, the following 
(10) changes must be made. First, since another sensor is 
not influenced by the orbit, the measurement matrix in 
(5) is replaced with 


H k = 


0 

0 


Ha,k 0 ‘ 
0 [b k x] 


(18) 
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where by is the measured vector. The effective 
measurement, z k , is based on the sensor measurements 
of the given sensor and is computed as for the 
magnetometer. The computation of R* is as given in 
(14) with R T am replaced by the noise covariance matrix 
of the given sensor. Based on the results of Reference 
2 and 5, the 3 rd and 6 th rows of H k in (17) above and 
the corresponding rows and columns of R* are 
removed. This is to prevent singularities. 

Propagation stage 

The propagation of the state estimate, based on 
equation 1 is performed as 

X k = f(X k (t),t k ) (19) 

Where X k is the state vector described above except 
that it contains the estimated quaternion computed 
from the angular error estimate. The updated estimate 
of the state vector is propagated from time tk to tk+i as a 
solution of the dynamics equation. The orbital 
dynamics equation is non-linear and describes a central 
force including both J2 effects and drag 3 . The orbital 
elements are propagated using a 4 th order Runge-Kutta 
integration. The differential equation which governs 
the propagation of the quaternion is linear and is 
dependent on the estimation of the spacecraft rotation 
rate 6 . The spacecraft dynamics equation is also non- 
linear and the rate estimate is propagated using Euler’s 
equation. The external torques, momentum generated 
by the momentum wheels, and inertia tensor of the 
spacecraft are required. The numerical solution is 
obtained with the MATLAB ODE function. 

The propagation of the covariance matrix is 
performed using the following equation 

P k+ i(-) = A k (X k (+))P k (+) A k T (X k (+)) + Q k (20) 

where Qk is the covariance matrix of Vk of (1) and A k is 
the approximated transition matrix. A k is computed 
using the following first order Taylor series expansion 

Ak = I + F k AT (21) 

where AT is the propagation time step. The Jacobian 
F k , computed from f(Xk(t),tk), is derived for the orbital 
dynamics in Reference 4, for the attitude dynamics in 
Reference 5, and for the spacecraft dynamics in 
Reference 2. 


RESULTS 


The algorithm 

is tested 

with 

noisy, simulated 

magnetometer and 

sun sensor data. 

The simulated 

data is based on 

the Rossi 

X-ray Timing Explorer 

(RXTE) satellite which is in 

a near 

circular 560 km 

altitude, 23 degrees inclination orbit. 

The length of the 

data span is 48 hours. Table l lists the true’ state 

variables and the initial state used in the EKF. 

Table l. True and Initial State Parameters 

Parameter 

Truth 


Initial 

a (km) 

6956.7 


7956.7 

e 

0.00197 


0.002 

i (deg) 

22.96 


22.5 

n (deg) 

109.74 


110.74 

w (deg) 

220.04 


225.036 

q (deg) 

18.19 


28.19 

Q 

2.2 


0 

qd) 

0 


0.0454 

q(2) 

0 


0.0416 

q(3 

0 


0.0454 

q(4) 

1 


0.9971 


0 


0.1 

(deg/sec) 




COy 

0 


0.1 

(deg/sec) 





0 


0.1 

(deg/sec) 





Results of three tests are presented. The first test 
(TEST 1) contains inertial data with continuous 
coverage of both magnetometer and sun sensor data. 
In the second test (TEST 2) an attitude maneuver is 
inserted after 5 hours. The maneuver lasts 10 minutes 
with a rate of 0.15 deg/sec applied to the z axis. No 
control data is input to the EKF during the maneuver. 
In the final test (TEST 3) the sun sensor is occulted 
for 60 percent of each orbit. 

Figure 1 shows the RSS position error from the first 
test. The final average errors are approximately 20-30 
km. It appears that the estimate is still converging. 
The final velocity errors are less than 0.025 km/sec. 
Figure 2 shows the attitude estimation errors and 
Figure 3 shows the rate estimates. The attitude errors 
are less than 2 degrees per axis. The rate errors are 
centered around zero and converge to less than 0.003 
deg/sec on each axis. 

Figures 4 through 6 show the RSS position, attitude 
errors, and rate estimates, respectively, for the second 


4 

American Institute of Aeronautics and Astronautics 



test which included the attitude maneuver at 5 hours or 
approximately 3.1 orbits. The position estimates 
improve with the final average RSS position errors 
approximately 20 km. The velocity estimates exhibit 
similar behavior to the position estimates with final 
errors comparable to the first test. Since the maneuver 
was 90 degrees the attitude errors are comparable to 
the first test with a change of axes. The attitude errors 
average to approximately zero. The rate estimate is 
comparable as well. Figure 7 shows an expanded view 
of the z axis rate at the time of the maneuver. The 
estimate follows the maneuver. 

The results of the final test are presented in Figures 
8 through 10. The attitude maneuver again occurs at 5 
hours. The RSS position error, shown in Figure 7, is 
comparable to Figure 4 with slightly greater 
oscillations, but a slightly lower final average. The 
same is true, again, for the velocity errors. The noise 
covariance associated with the magnetometer was 
decreased for this test, resulting in the improved 
position estimates. The attitude errors degrade at 
times with the loss of the sun data as do the rate 
estimates. But overall, the filter results are reasonable 
considering the estimates are based on magnetometer 
data alone for 60 percent of each orbit. 


CONCLUSIONS 

Results of three tests of the EKF are presented. The 
first consisted of 48 hours of noisy, simulated 
magnetometer and sun sensor data with an inertial 
attitude. An attitude maneuver was inserted for the 
second test, and finally, in the third test the sun sensor 
was occulted for 60 percent of the orbit. In all cases 
the EKF simultaneously estimated orbit, attitude, and 
rates. Starting from initial errors of over 1000 km and 
2 km/sec in position and velocity, 5 degrees per axis in 
attitude, and 0. 1 deg/sec per axis for the rate, the final 
average RSS position and velocity errors are 
approximately 20 km and 0.02 km/sec, respectively. 
The attitude errors are less than 2 degrees RSS, and the 
rates average less than 0.003 deg/sec per axis. The 
EKF was able to detect and follow the attitude 
maneuver, without any control data. Finally, the EKF 
was able to perform without continuous sun sensor 
data. 

Future tests with longer data spans, real spacecraft 
data, and inflight test data are planned. In addition, 
further tests will be conducted to determine the 


minimum sun coverage needed per orbit in order to 

achieve reasonable estimates. 
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Attitude Errors - TEST 3 


Figure 10 . Rate Estimates - TEST 3. 
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